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ABSTRACT: 


Some  interceptor  missiles  as  presently  formulated  possess  a  programmed 
thrust  magnitude  history  with  a  gimbaled  engine  to  provide  steering.  We 
examine  one  such  missile  to  determine  whether  performance  can  be  improved 
if  we  allow  a  variable  thrust  magnitude  together  with  engine  gimbaling  to 
provide  control. 

Two  trajectory  optimization  programs  were  written  to  provide  an  initial 
answer  to  this  problem.  Preliminary  results  indicate  reductions  in  the  time 
to  intercept  by  as  much  as  thirty  per-cent  over  that  obtained  by  the  pre¬ 
sently  used  guidance  scheme.  With  tuning  of  the  programs  it  seems  rea¬ 
sonable  to  expect  even  greater  improvements  and  further  investigation  seems 
warranted. 
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Introduction 


Some  interceptor  type  missiles  as  presently  formulated  possess 
programmed  thrust  magnitude  history  with  a  gimbaled  engine  to  provide 
steering.  The  present  guidance  scheme  used  on  these  missiles  determines 
the  steering  control  and  hence  the  direction  of  the  thrust  vector.  We 
examine  one  such  missile  and  answer  the  question  as  to  whether  perfor¬ 
mance  can  be  improved  if  we  allow  a  variable  thrust  magnitude  together 
with  thrust  direction  to  be  controlled  by  some  guidance  scheme. 

In  order  to  take  the  first  step  in  answering  this  question,  two 
trajectory  optimization  programs  were  written.  These  were  designed  to 
determine  optimal  histories  of  thrust  magnitude  and  direction  in  order 
to  obtain  minimum  time  to  interception  for  our  missile  under  given 
scenarios.  While  the  programs  are  not  in  a  finely  tuned  state,  neverthe¬ 
less,  preliminary  results  indicate  reductions  in  the  time  to  intercept 
by  as  much  as  thirty  per  cent  from  that  obtained  by  the  present  scheme. 
With  tuning  of  the  programs  it  seems  reasonable  to  expect  even  greater 
improvements  and  further  investigation  seems  warranted. 


Model 

The  missile  model  used  was  two  dimensional  since  all  test  trajectories 
were  flown  in  a  horizontal  plane. 

Letting  the  indicated  terms  have  the  meaning  specified  in  the 
nomenclature,  then  the  picture  of  the  model  is: 
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Figure  1 
Missile  Model 
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The 

la) 

lb) 

lc) 

ld) 

le) 


differential  equations  for  this  model  are 
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yl  ■  y2 
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^  —  K 

y5  y5  1 
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y,  -  TT-FA  sin  AT  -  FN  _ 

4  -  —  E. 

y5  y5  2 


y5  =  -  TT 


8050 


where  i)  y^,...,y^  are  called  state  variables  since  they  define  the  state 
of  the  missile  and  TT,AT  are  called  control  variables  since  they  control 
the  state  through  the  equations  1);  ii)  FA,FN  are  functions  of  the  velocity 
vector  and  the  control  angle  AT. 

The  constraints  for  this  problem  ar£ 


2a)  0  £  TT  <;  14400.0 

TF 

2b)  /  TTdt  <:  38,500 

0 

in  which  2a)  is  a  thrust  level  constraint  which  says  that  our  thrust  must  be 
non-negative  and  is  bounded  above  by  14400  lbs.  and  2b)  is  a  condition  on  the 
amount  of  fuel  used. 

Our  task  is,  given  the  initial  conditions 


3a) 


Yt  >  y9  >  Yo  > 
0  0  J0 


0 


for  the  missile  and 


y 


for  the  target,  then  determine  a  history  of  TT,  AT  in  time  which 


(1) 


Detailed  equations  are  presented  in  the  Appendix 
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yields  a  minimum  for  the  time  of  intercept  TF.  Using  the  penalty  method  to 
include  the  constraint  of  target  impact  in  the  cost  function,  our  cost 
function  is  then 

4)  c  =  TF  +  UN{(y1  -  Y1T)2+  (y3  “  y3T)2] 

Method  of  Solution 

A,  General  Techniques  Available 

There  are  many  ways  to  attack  a  problem  of  the  type  specified 
above.  For  example; 

a)  the  classical  calculus  of  variations  technique 

b)  gradient  technique 

c)  conjugate  gradient  technique 

Of  these  a)  is  an  indirect  method,  which  seeks  a  trajectory  which  satisfies 
certain  necessary  conditions  rather  than  seeking  to  reduce  the  cost  function 
directly.  This  method  depends  upon  the  choice  of  the  initial  values  of 
a  set  of  multipliers  called  adjoint  variables  which  satisfy  a  certain  system 
of  differential  equations.  This  choice  is  often  a  highly  sensitive  one  and 
instability  in  attempting  to  converge  to  a  solution  trajectory  can  result. 

Methods  b)  and  c)  are  direct  methods  in  that  they  directly  seek  to 
minimize  the  cost  function  by  seeking  new  trajectories  with  lower  values 
of  cost  function.  All  of  these  methods  are  based  on  generating  a  sequence 
of  trajectories  which  converges  to  the  minimizing  one.  The  gradient 
technique  works  by  linearizing  the  cost  function  at  each  trajectory  of 
the  sequence  developed  and  iterates  to  the  next  trajectory  of  the  sequence 
by  changing  the  controls  in  the  direction  opposite  to  the  gradient.  The 
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conjugate  gradient  technique  is  a  step  more  sophisticated  than  the  gradient 
technique  in  that  it  generates  new  trajectories  in  its  sequence  by  effectively 
expanding  the  cost  function  in  a  Taylor  Series  up  through  the  second  order, 
thus  obtaining  a  more  accurate  representation  of  this  function. 

All  of  these  methods  together  with  a  number  of  others  were  considered 
for  the  problem  at  hand  and  because  of  greater  sureness  of  convergence 
the  conjugate  gradient  method  was  selected. 

B.  Brief  Description  of  the  Conjugate  Gradient  Technique 

This  method  is  most  easily  described  when  discussing  the  problem 
of  minimizing  a  cost  function  which  is  a  quadratic  function  of  the  N  variables 
x^,...,xn.  Thus  assume  that  we  are  given  the  problem  selecting  values  of 
x^,...,x^  in  order  to  obtain  a  minimum  of  the  quadratic  function 
5)  c(X)  =  d  +  BX  +  1/2  XTGX 

where:  i)  X  denotes  the  vector  (x^,...,x^);  ii)  d  denotes  a  constant  and  B 
denotes  a  constant  vector;  iii)  G  denotes  the  matrix  of  second  partial 
derivatives  of  c.  Given  a  starting  point  the  conjugate  gradient  method 
computes  a  sequence  of  vectors  Hq,  , . . . ,  along  which  the  function  c  is 
minimized.  Thus  starting  at  Xq  the  method  computes  a  direction  which 
depends  on  the  cost  function  c  and  the  point  X^  and  determines  a  value  X^ 
which  is  a  minimum  of  c  in  that  direction.  Next,  a  direction  is 

computed  at  X^  and  c  is  minimized  along  that  direction  to  produce  the  point 

The  sequence  continues  in  this  manner  and  it  can  be  shown  that  in  the 
absence  of  round-off,  the  method  will  converge  to  the  minimum  point  in  at 
most  N  iterations  (where  N  is  the  dimension  of  the  vector  X). 
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In  general,  as  in  our  case,  the  cost  function  is  not  quadratic.  The 
procedure  then  is  to  approximate  the  cost  function  by  the  first  three  terms 
if  its  Taylor  Series  at  each  iteration  point  so  that  it  has  the  form  of  a 
quadratic  and  to  develop  the  directions  from  those  approximations  as 
outlined  above  for  the  quadratic  case.  Details  of  the  conjugate  gradient 
method  as  originally  developed  by  Hestenes  for  linear  systems,  are  in  [1] 
and  its  application  to  general  functions  is  explained  in  [2].  Furthermore, 
the  technique  of  conjugate  gradients  works  on  more  general  functions  than 
functions  of  a  finite  number  of  variables  and  one  may  apply  it  with  some 
modification  to  functions  of  an  infinite  number  of  variables  (see  [3]). 

Thus  for  a  cost  function  which  depends  upon  an  infinite  number  of  variables 
as  our  cost  function  which  depends  upon  the  value  of  TT  and  AT  at  each 
time  point,  one  may  use  this  technique  to  seek  out  those  values  which 
minimize  it. 

C.  Application  of  the  Conjugate  Gradient  Technique  to  Our  Problem 

In  order  to  apply  the  conjugate  gradient  technique  to  our  problem, 
two  computer  programs  were  written. 

The  first  of  these  programs  was  written  using  the  conjugate  gradient 
technique  for  an  infinite  number  of  variables  as  referred  to  above.  This 
program  is  listed  in  the  Appendix  B  and  was  never  fully  checked  out  due  to 
lack  of  time. 

The  second  program  was  written  using  the  conjugate  gradient  method 
for  functions  of  a  finite  number  of  variables  as  outlined  above.  Now  as 
previously  stated,  the  cost  function  for  our  problem  depends  upon  infinite 
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dimensional  controls,  namely  the  magnitude  TT  and  direction  AT  of  the  thrust 

vector  at  each  time  point.  However  in  any  computing  machine  procedure  for 

integrating  the  differential  equations  for  our  problem,  only  values  of 

the  controls  TT  and  AT  at  a  finite  number  of  time  points  are  used.  For 

example,  in  the  simplest  type  of  integration  scheme,  if  the  time  interval 

is  denoted  by  DT  and  t  ,  t- ,  t_,...t....  are  the  time  points  of  the 

o  1  2  j 

integration  scheme  then 

y(t1)  =  y(tQ)  +  y(tQ).DT 

6)  y(t2)  =  yCt^)  +  Kt^-DT 

y(tJ+1)  *  y (tj)  +  y(tj) *DT 

y (TF)  =  y(TFHDT)  +  y (TF-DT) • DT 

where  y,y  denote  the  state  variable  to  be  integrated  and  its  derivative  and 
TF  denotes  the  final  time.  In  this  scheme  only  the  values  of  TT  and  AT  at 
the  time  points  t^  affect  the  trajectory.  Thus  our  cost  function  which 
depends  upon  y  at  the  final  time  in  turn  also  depends  on  the  values  of  TT 
and  AT  only  at  these  time  points. 

Thus,  the  computer  really  reduces  the  infinite  dimensional  problem 
to  a  finite  dimensional  one.  Furthermore  if  we  take  this  into  account 
in  formulating  our  model  then  our  numerical  optimization  scheme  which  must 
abide  by  such  shortcomings  of  the  computer,  will  be  surer  of  success. 

This  then  is  the  technique  used  to  adapt  the  finite  dimensional 
conjugate  gradient  method  to  our  problem.  The  integration  scheme  selected 
is  the  one  used  on  already  existing  trajectory  computer  programs  for  the 
missile  under  consideration  and  is  as  follows: 
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7) 


y5^j+l^  "  y5^j^  + 


where  we  have  denoted  by  i  =  1 . 5  the  right  hand  sides  of  1).  This 


integration  scheme  essentially  integrates  the  position  components  y^  and  y^ 


by  using  the  first  two  derivatives  of  position,  while  integrating  the 


velocity  components  y^,  y^  and  the  mass  y,.  by  using  only  the  first  deri¬ 


vatives  of  these  quantities. 

Besides  computation  of  the  cost  function  at  each  iteration  point,  the 
conjugate  gradient  method  requires  us  also  to  compute  the  derivative  of 
the  cost  function  with  respect  to  the  control  variables  TT(t^),  AT(t^). 

By  the  chain  rule  for  differentiation,  this  requires  that  we  first 
differentiate  the  cost  with  respect  to  the  state  variables  at  TF  and  then 
differentiate  the  state  variables  at  TF  with  respect  to  the  controls  at 
the  times  t  .  The  former  derivatives  are  easily  formed,  however  the  latter 
derivatives  are  formed  sequentially  as  follows:  According  to  the  inte¬ 
gration  scheme  7)  forming  the  derivative  of  y^(i  =  1,...,5)  at  tg  with 
respect  to  AT(tQ)  and  TT(tQ)  yields 


8) 


ayi^tQ) 

3AT(tQ) 


5 
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Forming  the  derivative  of  at  ^  with  respect  to  AT(t^)  and  TTCt^)  yields 


* 


9a) 


W 

3AT(t1) 


0 


3yj(ti) 

STTCt^ 


and  next,  forming  derivatives  with  respect  to  AT(tQ)  yields 


3AT(t0) 


ayj(to) 

3AT(tQ) 


"1  9fi(t0)  3yi(t0) 

i-i  9yJ(t0)  ^7 


3fi(to) 

3AT(t0) 


•DT 


9fi^t0^ 

3AT(tQ) 


•DT  i  =  2,4,5 


9b) 


ay^t^) 


3AT(t0) 


9yi(t0) 

3AT(t0) 


l 

J-l 


9fi(V  9y1(t0) 

3yj(t0)  3AT(t0) 


9W 


3AT(t0) 


r  ^i+l^V  9fi+l  (tp)  1  DT2 

fa  3yj (tQ)  3AT(t0)  3AT(tQ)  J  *  2 


•DT 


3fi(V  .DT  +  afi+l(t0} 


3AT(t0) 


3AT(t0) 


DT 

2 


1,3 


where  the  last  equalities  in  9b)  result  from  9a)  and  where  f  (t,  )  means  the 
function  f  evaluated  with  arguments  y(t^),  AT(t.  ) ,  TT(t^).  Similar  equations 
hold  for  the  derivatives  with  respect  to  TT(t^)  and  TT(tg).  Continuing  in 
this  fashion,  then  at  time  t^  we  form  the  derivatives  of  y  (t,  )  with  respect 
to  TT  and  AT  at  all  time  points  up  through  t^.  Forming  the  derivatives 

with  respect  to  AT  at  all  such  times. first  we  set,  (as  in  9)  the  derivative 

/ 

with  respect  to  AT(t^) 
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10a) 


5yl(tk> 
3AT(tfc)  " 


while  for  the  derivative  with  respect  to  AT  at  the  immediately  preceeding 
time  point  tk_^ 


10b) 


3AT(tk_1)  =  SATCt^) 


DT 


i  =  2,4,5 


ayj(tk)  ^(y,)  >DI  +  W 


3AT(tk_1)  sAicyj) 


3AT(tk_1) 


DT 

2 


i  =  1,3 


and  finally,  for  the  derivative  with  respect  to  AT  at  all  other  preceeding 


time  points  t  ,s  =  0,1,... k  -  2 
s 


8yi(tk>  wl(tk-l) 


9AT(t  )  9AT(t  ) 
s  s 


5  1£  (V  )  3y  (t  > 

}  - i - K-—-L  -  - J  nr  1=24' 


10c) 


^iV  3yi(tk-i} 


9AT(t  )  9AT(t 
s  s 


-1^  5  8tl^tk-l^  8y1 ^k-l^ 

>  jtl  8VVl>  8AT<V 


DT 


5 

+  l 


3fi+l(tk-l^  3yj  ^k-l^  DT2 

9AT(t  )  *  2 

s 


j=i  ayjOW 


with  similar  equations  holding  for  the  derivative  with  respect  to  TT  at 
all  time  points.  It  is  recognized  that  all  derivatives  of  the  state  y 
required  on  the  right  hand  side  of  10)  have  already  been  formed  at  previous 
steps  in  the  process. 

This  procedure  continues  until  we  reach  TF  and  thus  obtain  the 
required  derivatives  of  final  state. 


#■ 
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Since  the  cost  function  also  depends  upon  TF,  we  are  also  required  to 
form  the  derivative  of  the  cost  with  respect  to  TF,  however  this  presents 
no  difficulty. 

Results 

In  stating  the  results  of  using  the  above  described  computer  program, 
it  is  to  be  noted  that  there  were  severe  time  limitations  on  this  initial 
phase  of  the  project  so  that  only  a  minimal  amount  of  time  was  left  after 
formulation,  development  and  checkout  of  the  basic  computer  program. 
Consequently,  the  results  presented  herein  are  preliminary  in  the  sense 
that  no  "tuning"  (such  as  problem  scaling)  of  the  computer  program  to 
this  problem  was  done.  Such  tuning  will  produce  better  and  often  very 
significantly  better  results  than  the  basic  program.  Nevertheless,  the 
results  that  were  obtained  indicate  significant  savings  in  time  over  those 
obtained  from  the  presently  used  guidance  scheme. 

The  basic  missile  target  scenario  that  was  used  had  the  target  at 
20,000  feet  initial  range.  Both  missile  and  target  had  initial  velocity 
of  800  feet  per  second.  The  missile  heading  and  target  aspect  were  varied 
as  depicted  by  dashed  lines  in  the  figure  below. 
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The  results  of  the  conjugate  gradient  runs  together  with  a  comparison 
to  the  results  of  the  presently  used  guidance  scheme'  are  presented  in  the 
table  which  follows.  In  addition,  plots  of  some  of  these  comparison 
trajectories  are  also  presented.  In  each  plot  is  indicated  the  time  of 
intercept  with  the  target.  Finally  the  values  of  the  control  variables 
TT  and  AT  at  each  time  point  t^  are  listed  for  each  plot.  The  number  of 
such  time  points  or  equivalently  the  number  of  intervals  in  the  integration 
process  is  arbitrary  and  was  generally  selected  to  give  roughly  an  interval 
of  .25  sec  for  the  initial  trajectory  and  time  of  flight  which  were  used 
to  start  the  program  for  each  case. 


* 
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Comparison  of  Times  to  Intercept  Obtained  By  Conjugate  Gradient  and  Presently  Used  Scheme 
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.341433874412035 

•  3  42  56  Co  6>0 44  73 1 3  6 
.3439007378455^18 
•345393669010457 
•347084044090081 3 

•  348991 48 1 9  4 •  40 It 


-2 . 422284241 52342 1 E-07 
-0  '  .350001  0000O036:  8 
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, History  of  Thrust  Magnitude  (lbs.)  and 
Direction  (Radians)  at  Each  Time  Point 


Missile  Heading  -90° 
Target  Aspect  180° 


IHs-r-JST  USED  A.vJGLE  USED 


-1 .16466681 5PS5909E-05 
14399.99998927039  6 

14399.9999<04756/i  6 

1  4399. 99993062'--' 14  6 

14399.9999807254  6 

1 4399 .99993090/  67  7 

1  939 9. 99  -jr9B095S  16  7 

14399.99993112/485  7 

1 4  399  *999981 32 1 52  7 

1 4399  .99998 1 55864  8 

14399.99998185297  8 

14399.99998222689  8 

14399.99998270991  J9 

14399.99998334048  “  9 

14399.09998416803 
-1 .566493161 176776E-05 
-1  • 46027  493  54 7  52 3 2  E-0  5 
-1 .3 5704 1556 1372 91 E-0 5 
-1 .25687 1 1824P6963E-05 
-1 . 1 59822829443353E-05 
-1  .0659421870431  55E-05 
-9.752657448003086E-06 
-8 . 87 82 3 8 56 3 9 1  42 52 E-06 
-8. 03643002201 62 77E-06 
-7  .227474929841  107 E-06 
-6. 45 1607773021 927E-06 
-5. 70906462 979 53 42 E-06 
-5  .0000° 1 2 67 8 4 33 96 E-06 
-4.324949577390757F-06 
-3.683922571 8683 13E-06 
-3  *07 7 043 60986 82 48 E-06 
-2 .504968690771 78 7E-06 
-1 .968061221 1 18917E-06 
-1 .4701 74244710638E-06 
-1 .007127876053239E-06 
-5.7932633960681 6E-07 
-1  *871  98  6448  563  937  E-0  7 
0  0 


4.723242003744533 
4792  6229  49?  759 7E-0 2 
335285438950643E-02 
437690961 887 19E-02 
7971362021 13957E-02 
41 51 69 7 520499 5 5E-0 2 
622 1 22. 7002  365  74E-02 
7008763662 12 161 £-02 
8285094882961 93E-02 
01 4004523 56 74R4E-02 
273 575855923 544E-02 
63282  54  73 1 882  4SE-02 
131522395380691 E-02 
832  592  52  58  74304E-:02 
083958274495448 
7  .96950 1831 334 19E-02 
7.5950374i967636E-02 
7.3014551 4555067SE-02 
7. 06 79569748630 7E-02 
6. 8781 89976333292 E-02 
6.71 91 48077868842 E-02 
6. 58020 1445930 5 16E-02 
6. 4523 1595 17940572-02 
6 .32743446844471 8E-02 
6» 1979758741 75827E-02 
,6. 0  56  4120995  50  62  4  E-02 
5.8948921 71 735704E-02 
5. 704890 57 19658 51 E-02 
5 .47686 5053 7 802 68 E-02 
5.19991 70732 1 9 558 E-02 
4. 8697 94646 4643 6 5E-02 
4. 444098055 129932E-02 
3.92564  571 099 52 7 E-02 
3 .2726541 422 16548E-02 
2 .6214871036441 77E-02 
1 • 76851 4541 362738 E-02 
6*51331 3859402577E-03 
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History  of  Thrust  Magnitude  (lbs.)  and 
Direction  (Raidans)  at  Each  Time  Point 


* 

Missile  Heading  -45° 
Target  Aspect  90° 


'-T  IS  ED 


ANGLE  USED 

L  ,(>?.(■  tazz  “28993  16 
387651  ('•  7  7705  2  K  /i  . 


1  .633530408700*  'K-05 
1 4399  *999951 890! 0 
14399*9999  59  If- 494 
14399  .99995947651 

1 4399  *99995975883 
14399.99995308508 
1 4399  *99995338 534 
14399.99995369842 
14399  *99995403657 
1 4399  .99995441427 
1 4399  *99995434988 
14399. 999*55366 7 4 
14399*99995599447 
14399.99995677048 
14399.99995774172 
14399*99995896665 
14399*99996051725 
14399.99936248091 
14399*999964961 53 
3 • 360690567644473 E-0 5 
3  .05501  6234939948E-05 

2  •  7  6 1  K  8  1  0  6  5  8  8 0  0 1  2  E  -  0  5 


383939047180 42  6  3 
3801651728985935 
3771  757452  56*'  404 
3  712  75689906 1 592 
3581 180177472189 
34628804836824.31 
3346' 5420263271  7v 
3239179702043936 
3 13  5202020455658 
3036432 105026 1 69 
2942 1 86 4 6609093 f 
28513571 1 128434$ 
2762476770369699 
2673758108020489 
2583097067560104 
248802205668061 8  . 

2384328227279375  ' 

.2701896461683151 
.2705728921977258 
.2712376903123615 


2. 48 133727 1 2537 12E-05 
2  *2.1  3  47446230372  52-05 
1 *958432 54R230329E-05 
1 .716396195193501 E-0 5 
1 .4875970412171 1 1 E-0 5 
1 .27231 7324197033E-05 
1 *07089 559947662 7 E~0 5 
8. 83 7348332594896 E-06 
7 .1  1313397818721 6E -06 
5.5419S  Ht  /  18  54628E-06 
4. 1 307243 3062 8648E-06 
2  *887 4 62000867 2 2 7 E -06 
1 *8220903209441 55E-06 
9. 46727 1 32607903 E-07 


.2721  72565092  SI  23 
.2733844764567251 

•  2  74693927  592  3  52  7 

•  276  73 26 74934 SO 42 
•2/8943092 1 864 
•281 5757121560107 

•  284705 755486828  & 
.2!>840  5652S6  52l)!Bi 

•  2927  78  V'  3  5  702  0200 
.2979494508159624 
•304073678922899 
•31 13490206533355 
.3200292054864544 
•3304437549857585 
•3430223498022051 


2.764530320192844  E-07 
0  .3500000000003638  - 
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History  and  Thrust  Magnitude  (lbs.)  and 
Direction  (Radians)  at  Each  Time  Point 


Missile  Heading  -45° 
Target  Aspect  180° 


7FTRU5T  U5ETT - BTNOLt  OStir  -  ' 

1 *36732158 20051P3E-05  4*6371 70084295014 

-1  *39741  5958209399c. -.02 


1 4400 .00005733645 
1  4400  .0200  Sb553>’2 
1  4400  .00005378  582 
14400 .0000  520097  6 
1 4400 .00005010682 
1 4400 *000046 1 875 

1  4  400  .'.000460542 
1 4400 .00004386944 
1 4400.0000/  1 6542  1 
14400 .00003908793 
14400 .0000364487 
3 • 5041 698878861 3 l E-0 5 
3.21 6485 A- 7067 173 E-0 5 
2. 928264 0343 9 121 7 E -05 

2  *642542 5794672 47E-0 5 
2. 35833361 268661 9E-05 

'  2 .07563 1 87 53 5962 7 E-0 5 
.  1 .79441861 51 65447E-05 
1  .51 466  5623229  59  5E-0 5 
1 .236333325271 I46V-05 
9 • 593842453 1 32 1 46E-06 


-1 .281 51 47258910075-02 
-1 .3854456351 060042-02 
-1  .vr  90 .1660226769E-02 
-9.93638406  7 7 79 /' V 7 £-03 
7  .2216  1  92346  4  8  P-  6  Vf.-04 
1 .0341 713638797*9* -02 
1 .37884844351 43798-02 
2.  .59391  12885541  53E-02 
3*1655180971  1253)  K-02 
3 .57/0409/  5795267E-02.  . 

7  *  426 648621 34 40 bE-Op 
8 .1668059898296L-02 
R  *  7 5 7594 1 2 5 56 302 1 r -02 
9 .23831R277518468F-02 
9*63469  2  3 70081  2 8 8  E-0 2 
9  *9628877.3879246  1  E- 02 

*  1 023 1 6828785256 
*1044341 1376231 1 1 

•  10  3  9  4002  b  6  9 9 0  4 5  9 
.106722229588941 1 


6.8376 3  0 69  6  8 « 9 4 3 2 E-0 6  .10658072 9 9 7  43 4 2 

4  •  0 9 4 J  7 70 52 4 57 1 39 E -06  . 1 0 520 1 890680859 1 

1  . 3  6290 1 3  59636352  E-06  .1021200558159281 

0  9 .99999999999090 5E- 02 
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History  of  Thrust  Magnitude  (lbs.)  and 
Direction 


Missile  Heading  -45° 
Target  Aspect  0° 


THFfST  OSET  ASGUt  USED 


8. 63 609 1 880320598  E-06 
14399.999992241  IS 
14399 .99999235387 
1 4399  .99999246009 
1  4399 .99999263  6."- 2 
14399  .9999998314 
1 4399  .99999305048 
1  4399  330091 


5*4  9704  5771010X88 

4  .  8  7 4 6 2  3  5 5  7 4 5 0  9 9 4 E  -  0  2 ' 

5  .320  1 60  791  4 74908E-02 

6  .0682241  1  4497  ‘95E-02 
6.58399346371 108E-02 
7 .008778557860S89E-02 
7.4543 2  6  C  7  2  3  9  4:-.  6  4  E  -  0  8 
7 . 9297  7^0  4240 1  483E-02 


14399.99999359178 
14399.99999393462 
1 4399.99999434359 
1 4399  .99999483552 
14399.99993542933 
*4 • 1 678 44072779 003 E-06 
-3  .4673  1  83334347513-06 
-2 .809366742004528E-06 
-2 . 1 95648663283228E-06 
-1  .6282765062348431-06 
-1  •  1063 1 0 1 893091  YE -06 
-7  •  30 63.0 04? 06 306 9PE -07 
-2.03144602 1637576E-07 
0  0 


8 • 45270? 9 3  664  92  52E-02 
9 .051 50452605  6  4 8  E- 0  8 
9.771095047974996E-02 
.1068473379757659 
.1191950730603627 

- - PrV  506958862  1  1  62091.-08 

7  . 8 1  0  43  1  f )  40  7  7696 E-02 
7  .04883326468181 9E-02 
6. 1850 14095925982 E-02 
5  .2402  536  51 83  5 12 E-02 
4.11 5799875021 0672-0? 
2 .7128902778550091  - 0 2 
9.85041445751 12161-03 
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Conclusions  and  Recommendations 


From  the  table,  the  general  pattern  is  that  the  conjugate  gradient 
trajectories  have  significantly  shorter  times  to  intercept  for  all  cases 
with  the  greatest  improvement  occurring  for  the  longer  duration  trajectories 
and  the  a\  ge  improvement  being  around  25%.  The  general  nature  of  the 
conjugate  gi  /.Lent  trajectory  is  to  burn  at  full  throttle  for  as  long  as 
possible.  It  should  be  noted  here  that  these  results  represent  local 
minimums  of  the  cost  function  4)  and  not  global  mini mums t  There  are  other 
local  minimums  which  may  be  significantly  better  than  the  ones  obtained. 
"Tuning”  of  the  computer  program  and  more  experimentation  with  our  cost 
function,  to  determine  its  "hills  and  valleys as  a  function  of  thrust 
magnitude  and  direction  history  will  enable  us  to  achieve  these. 

The  purpose  of  the  initial  phase  of  this  project  has  been  accomplished 
in  establishing  the  desirability  of  considering  variable  thrust  engines  in 
conjunction  with  engine  gimbling  to  provide  trajectories  with  significantly 
improved  characteristics.  Specifically >  from  these  results  the  time  to 
intercept  has  been  improved,  but  improvement  in  other  characteristics  such 
as  fuel  used,  can  also  be  obtained.  Furthermore,  numerical  results  indicate 
that  an  engine  capable  only  of  restarting  in  flight  rather  than  a  continuously 
variable  one  achieves  these  improvements.  (1) 

It  is  noted  here  that  this  work  establishes  the  presence  of  improved 
trajectories  over  the  ones  presently  being  used.  Such  items  as  mechanization 
of  these  trajectories  into  an  actual  missile  have  not  been  considered. 

(T) 

However,  this  type  of  control  may  not  provide  the  global  minimum 
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Suggestions 

The  following  extensions  of  this  work  are  suggested: 

a)  Tuning  of  the  computer  program  (problem  scaling) 

b)  Experimentation  with  additional  cases  and  with  the  weighting  factor 
UN  of  the  cost  to  determine  the  best  value  for  reducing  the  time 

to  intercept 

c)  Modifying  the  program  to  consider  minimizing  the  fuel  used  till 
intercept  or  other  trajectory  parameters  of  interest 

d)  Modifying  the  computer  program  to  include  three  dimensional 
trajectories. 
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Appendix  A 


Conjugate  Gradient  Program 
In  Finite  Dimensional  Space 
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?  rOH-LH  PPFCIRION  a-:;<  \  '  l  ) -.  (  i  U  )  >  ti.-i  ( Sou )  >  b 
P.5  Dli-ifc  MS  I  O  N  Y0(5)iAT(5l’)/i"  C  R<  ) 

2.5  EXTERNAL  FUNC T, 

0  COMMON/F  .'A'J/IFL>LF  *  A*  'll  >LY1  T*I''iT3T*  Y  1  TO*  Y3T0*  U\*  TO 

a  DATA  CATC  I  )>  i  =  l  ,,V  )/ 

5  1ATACTTC  I  )  *  j  =  1  >'.* M  )  /  _  _  . 

(•  r'A T A  N*FST* LI  MI  T*  I  FL*P,  7 1  ,  j  Y 1  1  »  P-Y'3  f>  V 1  TO* T  3T 0*tW*  f*<.r  /. 


7  ]  AT  A  C  rOC  •  )  *  I  =1  *  5 ) / 

r  H.r'$=  .nnoi 

c  DO  in  1=1 *c  j-pmp 

in  I M=  c  I  + 1 )  /?. 

)  t  a  ;c  j  )  =  t  ;c  i  ,;> 

1  r  ak'gc  i  +  i  )  =  A'.  c  f  n 

13  1  Of  vT I  MUF. 

l/i  ARGC  M)  =  TF 

15  CALI.  PF  /  C  A  C  F  1 1 MC  T »  '1  *  A  -  *  F  *•-*  F.-M*  HP  ,  i.,  1  i*  J  1‘  >  J  i; •■.  »Fr  ) 

15  ,/RITF  C  1  ,  1  1  1  )  F  • 

17  HI  FOR  IT’ AT  C IX* 1PHMI N  CCS1  1 5  =  *  F  1  9  •f* //  1 X  *  1  1  HM I  N  PTS  A  ;K/> 

17.1  DO  1/(15  IX=1  *  X 

17.11  WRITF  C 1*1 41  A)  ARC C  IX) 

17.  IP  1-/11A  FCRMAT(  1X*F  19.8) 

17.1  ■>  HO  5  C  O.v'I  I  i  IF 


1  5  F  ,MF. 

P5  c. f  (JT  I  MF  FUNC  TC  m*  ARTT*  »  "TCN  (j:r'7T~H 

07  J  •  C  • 5  J  T  0\  M :>*Y0C5)*r  1 C 5 ) * Y J 1 C 5 ) * F Y«- 1 C 5 *  5 ) * r f  ol C b*2 ) * YU< 5* 2  *  50 > 
YJHK  5*2*50) 

P7.&  I  COBLE  PRECISION  APC-C  7) 

P7.5  PHl-LF  PRtCISIOM  (HHCM) 

07.7  DOUBLE  P5F0  I  AT  0.7  -A 

07  . 7  p  0U  A  L  F  PR'fCJSIOM  A  -y  m  p-A  *  I A  I  *  1  l  .1  7  >  .  a  1 
P7.<  )  Or'H  !•  PRfcC  IS  ION  HH.C  POP  ) 

27  .91  COEMG  M/PR  I  MT  /Hh*  AMR]  A*  IF  PR 

on  C:  nmi  I-  CLOSED  r  •  :  ■.  lAR'llAi.-v  .):•  IMF  •  1  ...  • 

31  COMMON  TAT* CAT*  5AT*  MiM*  1 1  *  t  P*  C5  * nSC 

3P  (1 I  '7  ■  CN/FFA  \V  IFL*LF*R*  II  *  DY1  T » LYOT*  T) TO*  \  3Tn  >  V  i,  r : ' 

A3  RFAL  tV.Nj 

*3 .01  DANGAP5=0  .0 

/3.0P  DO  1010  I  =2  *  N-l * P 

A"5  .0  0  PA NG >' A G « PAP S  CARGC  I  )-ht  C  \  +  I  )  ) 

/0-r/'  IF- Cpc  JPF  7  j.H;'P)  0  0  TO  1010 

AO. 05  DA  MGAPS  =  l  ANGK  AG 
/'>.< >-•  imo  CONTINUE' 

A3  .07  D  1  1  AD*  =0.0 

/■:>.  .ox  "0  !0po  i  =  i*M-p*  ' 


/•o  .<••«.  > .  r  7  F  AG*E.'ABS  C  ARC  Cl)  -H>  CJ+i)) 

A3.1  Tr  CDTTMAG.LF.  .DT'l  AAR  )(.iu  l'i)  1 /•■>>•. 
/•?  •  1  1  1  TTAP  -j  pM A 6 

/jO  .IP  1  oqo  CO.NIT  1  Ml  F 

/J?. .  1  ■>  y  |  ;CM.A  ("1  Ml  ''At  1, 

IFPR>,,TF="*ARGC  M) 

A/.  I  NDT=0 

A5  TPI=5.PR31 ADO 

/•5  M  M  I  =  M  I  +  1 

/-' 7  I  MD1  =0 

AR  INIG  =  0 

A9  CS= 1  1  1 7 . 77-AO .9P*R 

50  C’  c  C  =  •  1  7  34+.00PA3*  F  v  P  C  -  •  3  3  /  +  R  ) 

51  DT=ARGC  ,7)  /.MI 

5P  J=P 

50  10  10  1  =  1  jS 

5A  YCI)=YOCI) 

55  10  CONTINUE 

57  C: 

58  C  ? 

5A  C:  BIG  LOOP  FOR  I  Ml F  G •  &  IIFf. 


TAP 1 


•Oiv.rIA=' 


Ir  I  Ml  r G 
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60 

CO  15  1  =  1  >  5 

61 

DO  15  J*!»P 

6P 

YUC  I,J,1)=0.0 

1  5 

CONTINUE 

6/J 

IF  CIFL.EQ.O)  GO  TC  500 

6  5 

C: 

A  A 

C: 

A7 

C:  SIMPLE  INTEGRATION 

r 

6no 

CO  1000  J=5>*MNI 

r  " 

I  0  v  n  L=! , Co-1  ) 

70 

DO  520  1  =  1  >5 

/I 

DO 520  K=l,2 

72 

YU1UC  I  t  K>L  )  =Yl'C  I»K>L) 

73 

520 

CONTINUE 

7  4 

DO  530  L= 1 >  5 

75 

YJ1 CL)=YCL) 

76 

590 

CONTI  N(JE 

77 

IAT=2*C  J- 1  ) 

7* 

ITT= IAT-1 

79 

Iff  AP.3C  I AT)  ‘Gh  «0  •  0I>0 )  GO  TO  535 

«0 

ATU1  =ARGC  I  AT )  +  T.PI 

81 

GOTO  53R 

*2 

59  5 

I F C  ARG C  I  AT )  •  LF  •  TP  l  >  GO  ’10  5 37 

AT  J 1 =  ARG  C  I  AT ) -TP I 

K  /. 

GOTO  53  R 

Q  6 

537 

ATU1  =ARG  C  IA't  ) 

66 

5  3  u 

TTJ1 =  ARG C 1 V n 

*7 

MT  J 1 =0-1 

87  . 

6  CALL  FUC 

Y  «_■  1  *  A  T  «J  1  *  T  T  <  J 1  »  ■'sT  0 1  >  I  .'il  1  *  i!  U  » .  ’  ) 

f  0  540  1=1 

,  s 

8  9 

YC  I  )=YU1  C  I  )+FKl  C  I  >*!Vl 

90 

5^0  CONTI NUE 

9  1 

YC  1  )=YC  1  >+LF*FKlC2)*!T*DT/2»0 

9? 

YC  3 )=YC  3  )  +  LF*F  1  C  A )  *DT*I  1  /2  .0 

92  . 

5  CALL  GRADIENTC  Y01 >FK1 >FYJ1 /FUJI  >T1ol  ) 

93 

DO  550  1=1 >5 

94 

DO  550  K=1 *  5 

95 

FYJ1 (liK)s 

FYJ1  C I >K)*L1 

96 

5  50 

CONTINUE 

97 

DO  553  1=1 > 5 

98 

DO  563  K= 1 , P 

cu 

F  UJ1  C  T.  *  0=FUU1  C  J  ,t  )ti  'i 

1  or, 

1  > 

1 1  •’ 

ZW'  5  J  ’ 

1 1 

1 

C •  l  i  CT 

»  0  *  i  ’  .  hi  I  J  \lTEG  .  P  1  I  ALC 

1  0/i 

DO  600  a=1,J 

1  0^ 

S66 

IFC  \  •  ''JF  •  »J )  GOTO  u*7;  > 

n* 

DO  5 6M  1=1,6 

]  97 

DO 560  i.=  )  ,2 

108 

YUC I ,L , J) 

=o  .n 

109 

560 

CONTI  Ji.lv. 

1  1  o 

GO  TO  600 

!  1  1 

670 

1  F C  , .  }  ■•  .  (  <)-  1  )  )  ;  •  J  -  ••  • 

1  ]  9 

DO  ^0  1  =  1,5 

1  1  9 

TO  580  L= 1 ,2 

1  1  4 

YtJC  I  <  J-  1  )  )  =FU  J 1  C  I  , L  ) 

1  1  5 

580 

CONTI Vrb 

1  1  6 

TO  565  L= 

1  >2 

1  1  7 

YUC  1,L#<  J-l  >>^YUC  l,L»CJ-l  )  )+LF*F(JJl  Cf;,L)*DT/2 

1  1  « 

YUC  3>L>  C  J 

1-1 ) )=YUC  3>L, C  J-l ) >+LF*FUJI C 4» L) *DT/2 

1  1  9 

5B5  CONTI NUF 

1  90 

GOTO  600 

121 

590 

DO  595  1  =  1*5 

1?2 

DO  595  L  =  1  >  2  29 

1  99 

YUC  T  ,  L  *  K  )  =  Y  <J  1  DC  I*L*0> 

29 


124  DO  59S  I J=l»5 

125  ,  YUC I,L,K)=YUC I,L,K)+FYJ1 C I* I«J)*YJ1UC  I J, L, rt ) 

126  595  CONTINUE 

127  DO  597  L=  1  , 2 

128  DO  597  1=1 >5 

129  YUC 1 ,L,K)=YUC  1 , L, X) +LF*FYJ1 < I ) *Y J1UC I ,L, h ) *JYr/2 .0 

130  YUC  3,L,K)=YUC  3*  L,  K)+LF*FYJ1  C  4,  I  )*YJ1UC  I  ,  L,K)  *DT/2  .0 

131  597  CONTINUE 

132  600  CONTINUE 

133  1000  CONTINUE 

134  C:  SETTING  UP  TARGET  COORD. 

135  Y1 T=Y1 T0+DY1T*ARGC  N> 

136  Y3T=Y3T0  +  DY3T*ARGC  N> 

137  VAL=ARGCN)+UN*C CYC  1 )-Yl T>**2+C YC 3>-Y3T)**2 ) 

137.1  DISTAN=CYC 1 )-YlT>**2+CYC3)-Y3T>**2 

137-2  DISPLAYMDISTAN=",DISTAN 
13«  C: 

139  C:  ,  •  • 

3  4()  C:  COMPUTE  PARTIAL  OF  COST  V.R.T.  IK 

’  41  GRADC  N)=l  .0  +  2  CYC  1  ) - Y 1 T ) -+  C FK 1  C  i  )-EYlT)+C  'i  C 3  ) -Y3'i  >  +  CFhl  C3  ) 

E-21  )  ' 

142  C:  FORKING  PART  I ALS  OF  COSH  W.R.T*  U 

143  ‘  *CTY1=?.0*UN*CYC  D-Y1T) 

1 44  CTY3=2.0*UN*CYC3)-Y3T) 

146  DO  620  K= 1 ,  ( N-2 ) ,  2 

14 r-  KK=CK+1 )/2 

3  4  7  GRADC  K)=CTY 1 *YUC 1 , 1  ,KK) +CTY3+YUC 3,1, KK ) 

L4P  GRADCK+1 ) =CTY1 *YUC 1 , 2  ,KX)+CTY3*YUC 3  , 2  ,  Ah ) 

3  40  620  CONTI  NUE 

160  C : 

151  C: 

15?  C:  PRINT  COST;  G  VIOLATIONS#  BAD  TAT  VALUES 

153  WRITE  Cl, 777)  VAL, I NDG, I NP1 

154  777  FORMATC 1 X,  4HVAL=  ,  F 1  9 .8,  5X,  5H I  NDG  =  ,  1 8 , 5X,  5HI  ND1  =,  18  ) 

155  Ct 

1  56  C : 

167  Cs  COMPUTE, FUEL  USED 

158  FS=0 .0 

159  DO  630  I  =  1 , C  N-2  > , 2 

160  FS=FS+ARGC I )*DT 

161  630  CONTINUE 

16?  WRITE  Cl, 888)  FS 

163  88R  FORKATC  IX,  10HFUEL  USE.D=, F 1 9  •  8  ) 

164  C: 

166  C: 

166  C:  COMPUTF  THRUST  VIOLATIONS  AND  KAX , M I N  VALUES 

167  TTKAX=1 4400.0DO 

168  TTMI N=0 .ODO 

169  DO  6R0  I  =  1 , C  N-2 ) , 2 

170  IFCARGC I ) .GT.TTKI N)  GO  TO  660 

171  TTMI N»ARGC I ) 

172  I NDT= I NDT+ 1 

173  GO  TO  680 

174  660  IFCARGC I ) .LT.TTMAX)  GO  TO  680 

175  TTMAX=ARGCI) 

176  I NDT= I NDT+ 1 

177  6R0  CONTINUE 

178  C:  PRINT  NUMBER  OF  THRUST  VIOLATIONS  AND  MAX, MIN  VALUES 

179  WRITE  C 1,9999)  I NDT, TTMAX, TTMI N  . 

180  9999  FORMATC IX, 28HNUMBER  OF  THRUST  V IOLATI 0NS=, IF , /, 1 X, 

6HTTMAX= ,F 1 9  *8, /, IX, 6HTTM I N= , F 1 9 • 8  > 

182.4  1212  CONTINUE:  , 

183  2222  FOR>  AT  C 1 X, 4HVAL  =  , F 1 9 • 8 , 3X//1 X , 1 OHYUC I , 1 , 1 )  =  , 
3F19.R/1X,2F19.8/1X,10HYIJC  1,2,1  )  =  ,  3F1 9  *841  X.,  2F1 9  .8  /  I X  ,  1  OH  YUC  1,1,2)  = 
3F19.R/1X,2F19.8>  30 


1  R3«>A  FORMAT  (  1X»  lO'rsYLK  I»  1  »3)=»  '■>!•  1  •  *  / 1  F  »  R  F  1  9  •  8  / 1 X  #  1 0  H 1 1  C  l  ><>  »  O  =  > 

AF1  9.R/1  x:,PF  1  9  .*/l  X#  1  OHYIK  3M  !r  1  9  «H//1  X#  1  1  hG.-r  A?1  WYLOfcS/) 

1^  l-JRITFC  1  ,Zi4/:A)  CTYl/CTY3»(Y(I)WBl*‘0>Yf  .  AT 
1 « ^  hnnn  FORXAT<  1  X*  5HCTY1 »# F  1  9  .tf#  SX#  ‘'-iO  i  =  #F  1  >.»• /!  X  # ‘.r.  <  I  >  *  # 

]0.-/iX;?F  IQ.P/l  Y>/iMYl'  =,Ht'.'WS  ,  'ih  .F  ) 

If'V  f-f'OP  BFTURM 
]BR  EMD 

P^l  c-(  -3ROUTI  vfc  FUCY/AT# T1  #MT#  I  '1M  »1  \))'ij,Dt  > 

PPP  D  IMF  NS  I  ON  Y<  5)  »B(  b)>DY<  Si 

PPT  COMMON  TAT# CAT#  SAT  M  #  “  P  » C.s  »n  1  L 

'rrr  i  I'A  TT  (r(  (  )#  r-l  j‘ ;)/0.f,  a  . »  .!■  «f  >  3t*#-f  -f  if/ 

ops  RFAL.  •rii'J 

p  /  p  I  =;i .  l  Zt  1  59 

pp  c  v.  MR  =Y(  ?  )  **P.  +  Y  C  A  )  ■■<  :  P 

"■■  '--Fi'FTfVMSJ 

ppn  OS=OSC*V‘vS 

P  A  i  <N=V'/CS 

opp  TAU=ATANP( ) ( 4) ,Y( P)  ) 

A  A  I  F<  TALI. OF  .0  .0)  GO  TO  PI  in 
TAP  =  TAU  +  ?  .0*P  I 
P  AS  ‘lio  CONTI NUF 
PA/-  T*-’(-=1  AO-AT 
'PA?  A  r '  -  A  h  s  (  TAT) 

PAR  1 (  A  3  .01  .PI)  GOTO  A 

PA  ) 

P/o  -01  C  5 

P-.  1  A  ALP  =  P.r  $  A I  -  A- 
:  ')  A  1  ~  1  # 

P  /■ :  ••  r  (  f  -  V  . }  r  .  ■  (  •  )  )  i  ;  •  ,  '  • , 

1  f 

■  Ti  IP 


P/!S 

1  A 

i  ir  i  =  i 

•jni  + 1 

p  /■  '■ 

I  V 

i F <  TA  I 

•  P  r  .0 

;  i\'i 

r  .« 

f  '  >  !  •  1  F 

•  -  1 

tft 

F  1 

I  <i(  A 1 

) 

.  ■  /!  '• 

F:J 

=-COS  CAT) 

PS‘! 

GO 

TO  ^0 

1  S 

FI =-SI 

MC  AT) 

PSP 

^  3 

F  o 

=COSC AT 

) 

•••'-  ■  :  F  PM  I  MG  CA  A  P  CN  FT  'JC  T 1  O  •JS 

P  so  P(i  CC  A  =  0  .  s  P  S  A  +  C0C  (  P  .  S?  1  4  *  A  L>  ) 

'  1  V  ■'/  ~  H  ^  p  +  U  C  A  *  I  \  1  (  0  •  A  s+ 0  •  1  ' '  if  ,  >  1  •  I  /  —  f  •  7  .  ) 

psp.  CC  \=-  c  .PS 1  7 }■  -'V,  4*  (  1  •  Q  -  P  3  •  >  1  9p*AlP*(  1  •(:•  +  s  •  Y^3  r  +  (  1  •  0-  *6  65^*AU  *  ( 

1  .  -  .  \  5flO*ALD  )  )  ) 

')  ,CM*A.\I  ,v1  C  .30+.  S--*!  5,1  .  .) 

P-P  F  \J=*=C  \‘*0S 

•'  *3  FA  =  :.A*CS 

Vft :  IFCFN/YC ^) *LF*1 3S3 .0)  GOTO  -  < 

PAS  I  *11)0=1  G+  1 
•:  *  >  3  C  AT=C  OSC  AT  ) 

P*7  SAT=SI.\IC  AT) 
of*  ft  rye  1  )  =  Y  (  P  ) 

PA  )  T  Y(P)  =  c  C  TT-FA  )  *C*vr-f  N^i-  1  )/  (  s) 

P7  r> (P)=YCA) 

9  71  CYC /j)  =  (  (  TT-FA  >*3AT-h 
9YJ'  I  7(  5)--TT/P050  *0 
P 7 A  PFiiFFv 
87  7  FML' 

'>  m 

pR  7  Sni-G  Ot'TI  Mh  iiF-A)  i;  JlC  >  I  r  ^  \  .t  v  »  ■  .  ) 

PI  .y;F  IS  T  0  v  YC  S)  >  LP  YC  S)  >  DF  C  c  ^  P  )  >  i  Y(  s  ) 

.  (  #  {  ,  1  ;  •  i  P.\  ' '  ^  •  ;  »  ■  ♦  v  M  *  .»  f  1  .  •  ^ 

pH  i  ATA  P  )  /9 . 1  /1 1  S  */ 

PQ  1  P  h  At,  Y  .»i>  n}  Y^i  >  'J 
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Pr*  TF  C  r 't:  .p  F.  0*0  *AML.  TAT  .LF  .  PI)  GOTO  3  5 

?c?  Jh  (TAT  .LF.  -PI  .OP.  TAT  •  hO .  ?.Q*PI)  GOTO  3  5 
294  F 1  AT- CAT 
P9  5  r'PAT=5iAT 

ALPTAJJ-- 1*0 
97  GOTO  AO 
'•  3  5  ALPTAtJal  .0 

poo  FlAJss-CAl 

3^0  fpat=-sat 

30  1  4  0  ALPAT- -4  LPTAU 

30  p  0  s  V  >  sQ  S rj  *P  •  o +  y  (  g  ) 

3f  3  0SY4=0SC*S>.0*Y<4) 

"jn/  yc  p  >**g  +?< A)**g) 

30  5  l  ’■*-  "OF  1‘(  / 5  ) 

;C5  -.=;.)CC*V*.S 

30  7  C I  A  =YC9)/VF 
3nw  F TAP-YC 4) /V • 

300  ALPYP  =  -AL?'J  V**  T<  .  )/  > 

31°  A  • .  •  ■  A  LP  T  A IJ*  Y  (  .?  )  /Vy  .'i 

31i  j Ms  =C  (A.  ,/C 
1  ■■  J  ,  /•»:-  .  1  ‘  /(.; 

•  *  <1  •  I  MO  DF-  -  1  I  vr.S  G i1  i )  Y  j  •  •  f  •  ,  t  A  I.  •* 

31  r-  / - }  rr  (  T6'i  ) 

•  ]  7  *  (  '  •  C  T  •  ? I  )  00  TO  4 3 

3  1  A  f.\  L  -  .t 

•  1  '  t  4  4 

300  /•'■>  *1.  -  -:P  .0  *P  I  -AG; 

3P  1  /•  /:  CCA'-* 0  .9£*3*C0SC8.S71  **AlP) 

3>P  --0.5565  +  CCA  +  A-' 1  \I1  (0  .^5+^  •  l  .3  M>  t  *  i  7-  .  O  ,) 

S  1  f  C  r-(  i  .0-00  1  f*AL;  ••;(  1  .O  +  O.s  F  ',**ALP*<  1  .o-  .005O4AL.P  +  C  1  *0-  .1  5*0 

)  )  )  )*5 .0  ^»37F  -p 

3£4  C  \i-CCM*P.v  I  Mi  (  .^P  +  0 .55*.  M*  1  .U\)5-P  .0  i) 

3P*  CA-'  i  •  --P  •  ^  3703  1  *5  I  J(  P  •  57 1  /**AL:  )  :•  AK I  .  j  1  (  O  .  f  3+0 . 1  -  j,\  .\  v.V-  .  J  7 

"•P4  Jr  (  '  A:  •  L  F  •  ]  .15  5)  GO  TO  4  u 

32  7  oa  vi  .  i  70*CCA 
3?*  GO  XP  A 7 

3P9  4 3  C A Y V  =  •  1  3*CCA 

33  0  {.  j  JO  J4  I •  "i  /  “  (  “  . >  )  -  3  •(  (  <  *:  <  ALr  +  v’  1  *770:  ^AL.r' 

pr.p-  .  -T3P536*  ALP*ALP*ALP  ) 

331  CMALP=CC  MALF*AMI  Ml  (  .3  +  .55*0  M  j  1  .095-0  .074*yjM) 

330  IFC^M.LH  .1  .P75)  GO  TO  43 

333  C  Mi<,M=-0  *074  *CC  M 

334  GO  TO  49 

335  /:«  CM-  j=i55  +  CCM 

330.  /  :>  }  -h  y  (  p ,  )=((-<  C  AGO  C  l  +  C  J  *  '  !  1  )  'A;..  \\-iy.i !  •»  ».  ’  1) 

•  V ^  ) '  '  -  (  •  P  i;  ;  n  :  1  :  •  /  ■  (  ) 

:•  •  i  LI  " ;  .  .7'  -  i\*CAM  +  C  \  .v  r  1 

)*!VM  y/j)  ;-^S-(  CA -COT+  \):  ri  V  ZO/'-,  <  ) 

;  3  i  f  ,  ’i  rs  -  f  w  C  S  > 

c  AJp)=c  ( -<CAAL?*C  -•*]  +C  :F+L;  )  -  <  :  -  i  +SAT  +  C  M  -  v*  t  ’r 

)  afriV iVYP  )  *05  -  (  CA*S  AT  +  C  )  * 0 S  YP  )  /Y  (  5) 

3/C  lM(/i^)=((  -  (  CA  ALF  •  T  "T  +C  ■  LF  4EP)  *ALP  Y4-C  CA?<M+'5AT  +  C  MXM  -  FJ 
)+  MY 4 ) *0S - ( C A*S AT+C M*HP ) +n  c Y4 ) / V ( S) 

341  I  FYC/^  5)=-PY( A)/t ( 5) 

34P 
3  /:  3 

.3 4 /  r  ?  YC  1  >  1  )  =0  *0 
345  FFYC !^P)=1 *0 
3 40  PF/C  ]  ^3)  =0*0 
3  47  TFYC ]  WJ)=0*0 
3AM  PF  YC 1 >  5) =0  .0 
349  PFYCP* 15=0.0 

3  50  l  ip  Y  C  o  ,  3  )  =0  .0 
351  PF  k  C  3 j 1  )s0.0 
3-P  PF  j  C  3  *  p  5  =0 • 0 
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3  53  DF  Y( 3  *  3  )  =0  #0 
3-/  T'F t '  > / )  =  1  .0 
355  *  FY(3>5)=0*0 
3- 5  DFYC**  )  >=0.0 
3-7  OF'  (  >=0  .0 

35*  DFYC 5> 1 ) =0 • 0 
3  59  1 FYC  5  *  P  >  -0  •  0 
?50  PFY  (  5,  7  )  =n  .r 
<M  1  F  Y (  5>  4  > sO  •  0 
35P  5  F  i  (  -  )  ~0  .0 

3f  ^  }  FIKP*P  )  =  ( -CCAAU -*C 
SAT ) *GS/Y ( 5) 

3r-/J  DF:t(  />,£  )=:( -(CAAL:  '*SA7+C  m-l  ’•  1  ) 
3 ^.5  !  FUCP*P)=DFM(P^P)-T  :+S^T/Y  (  5> 
3f  /•  .f  DrUC  )=DFUC  4> P  )  +  TT*C AT/Y (  5) 

355  DFiTC  lil  )=n  .0 
DFK  J  iP  >  =  0  .o 
3*7  T  F  U<  3  *  1  >=0*0 
s >  c- )  =  0  •  0 
DFO  (3,P)=0-0 
nr  ?(n,  i  )“i  .o/  (  -■>) 

.<-/K  (  >  : 


AT  +C  m'Ai.P  +  Y!  )  *  * l 


n 


T-C  1  A1  +C«v 
r- o j* .  i •  +Ck1 


/  c 
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3  0 
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GOTO  1 

46  7 

P7 

•0  =  ALFA  *  POO  -TCI  FA  ) 
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A y , v  a  « C  .•  :+;  -  Z  )  +AXLI  A  /  C  DY  + 

4  4  O 
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47r 

P* 
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✓•70  •  c* 

v)  <;f 
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'7  1 
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?9 
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47  4 

30 

PALFA=0 -DO 

47  S 

r.^0  31  1  =  1  *  p3 

476 

31 
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477 
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F  V  =  F 

4?n 

DV=LALFA 
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Axv.AI>A=rr. n  v] -A-ALF 9 

i  0  TO  PO 

h  9  1 
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49- 
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PC  715  1  =  1  j  P  *  :J 
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H'-  (  I  )  =  H(  I  ) 

4  5.01 

7  3  5  COlVT  I  MUF 
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500 
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r>!  '  5 
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Appendix  B 

Conjugate  Gradient  Program 
In  Infinite  Dimensional  Space 
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1  Cs  THIS  PROG -'AM  DOES  COSO.  GRAl  •  FGr  :ISSLh  THAO. 

9 
3 
a 

5  DI  >  EaJSI  OS  TT<81 >#AT<81 )#E1 <81 >#£8<81 >#B( 5>#Y<5>#LAtt<  5>#TAT<81 ># 
Y2<81  )#Y4<81  )#CA<81  >#rM(«l  )#CAT<81  >#SAT<81  >#Y5<81>#F  •<  1  >#r/j(Rn# 

1  t.A h <  5 )  #  Dt  <  5)  #  HAT(  8  1  )  #  HT<  8 1  >  #S  1  <  8 1  >  *  S2<  8 1  )  #TT  1  <  8  1  )  AT  1  (  8  1  >  #  Y 1  9. (  5 1  > 

6  DIMENSION*  Y1  8 1  )#Yl(5)#  YO  (  5 )  #  TOY  l  <  8 1  )  #  E 1 1  (  *  1  )»tlKi  1  >  #  0  '■?  1  ( >.  •  >  # 

CA1  <81  )  #  C  A  T 1  <81  )  #  S  A  T 1  <81  )  #  Y 1  5  <  8  1  )  #  DY1  <  > )  #  <-  1 :  :(  *  1  )  #  E 1  A  <  f  !  )  #  ATL(  8  1  1  # 
TTL(  8 1  )  #  EL  1(81  )  #  F  L8  ( 8  1  )  #  TATL  (81  >#YI.8<8)  )#  -<\  )  #C  iL<  >  *  ) 

7  DIMENSION  CNL<81  )#CATL<Rt  >#SATL.<8n#YL5<‘  i  ),H  (8)),  l.~(  ]  > 

8  DATA  I  TMAX#  I  TG  Ft  A  / 

<•  FATA  SCO#  \'C  1  #  1C  9  #  SC  3  #  >1C  <■'  #  C5#  A',f- >  07  #  ,(>  #  yC 9 #  NCI  0#  NC  1  1  /  •2306',RR  1  # 
3  .9  ARM  97#  2f<  •* 09739#  -90  .959979#  A  .  1 36989/  #  -  •  1  H«7A3»  •'.*  #  *50  764409# 

-» 1 2286 1  7 1  #  1  .3  57  6H  <  3  #  —  '•  1  A42  47 1  #•  3  *>-'!Y  s:  ’< !  #-•  ■  < ■  ti  #3  / 

10  DATA  <TT< I >  #  T “1 #  8 1  >/ 


11  1  >A  f A  <AT<  I)#  1=1  #  I/*)/ 


11  .5  DATA  <AT<  I)#  i  =  l  S#9S)/'. 


]  9  jv  iA  (  0<  1  )#  C "  1  )  / 

1 3  nr  •}<  ,  TF  .• '  :  ’  *  ■'■  ,  y,  .. :  .  / 

J  4  DATA  (  3(  I  )  #  X  =  1  #  S)/0  .0#  3  .  w  '  5;  ,  .•  h:  '  <#-6.28318/ 

15  DATA  CCO#CG  1  #008 #<;C3# UC *#<:<>»':.  :*#0f: 7  #(/.<  -  » ■  :(-.«•••# CC  10#CC1  1  /..3057/:0'->  # 
2  .  5373  7 1  #  -  It  .98/  872  >  1  l  .098*  1  I  #  -3 . 755  '■<  3  #  ./••<*/'•  #  .?SA  VOID  ># 

•  35338886#  -.P5R2.  82  >!-•#  .  )71  1761  5>  1 )  •'  9C  6 1 6#  *0017203x65/ 

1  A  PI *3 .1 41 59 
17  2  I TG= 1 

1«  I ND  J  =f  • 

19  IND<i«0 
80  I TL=0 

9) 

92 

2  3  C:  COMPUTF  INITIAL  GRADIENT  f  <A.J;-(;TO-  7 
2  A  DO  >'  I  -  1  #  S 

P5  Y< I )»Y0< I) 

2  a  A  COST  I  \IUE 

27  CS  =  1  11 7 .77-40  .92*H 

PR  0 SC=  •  17  3A*  .002/‘3*t'F-  <  -  •  33 7,  /If  5 

2  9  )  r  /?■  .r 

3<  1  :■  ■  l  =  i  #;  1 

31  \  (  7>~Y<2> 

32  YA  (  1  )  =  Y  (  A  ) 

72.  "  ■  •  c  ;<:•')  •+'.('')  •  * 2  . o 

33  VM=SQRT<  IMS) 

34  QS=QSC*VfS 

35  MN=VM/CS 

7  6  TAU=A  TA  N8  <  v  <  /< )  #  ( y  )  1 

37  TAT(LT)=TAD-A1 <  ) 

3-<  A9=A3S(TAT<  V.T)  ) 

39  IF(AB.GT.PI)  GOTO  3 
AO  ALP  =AB 
A1  GOTO  3 

'9  3  ALP  =  2.0  *  PI  -  AO  37 

/.  6  DO  I»  1  #  > 

is?-i  IP  <  T- •  )■<  1  ) .  E  r*  •  (  (  >  )  >V;  i  ' 


i  5  C '  )  '!']  I  U 

i "•  •.  -in--:  :r 

* -  j’FC*:6fv  ^*.1*  *+*^»-**ysfr*  -i»T  C 1  Tf H."»  ■  ‘  --*• 

r  c  ' ,  •'(  t  i  .i  .  o  •■  :M  •! 

i  c  ).-  ■  <  •«•  i  •  • 

50  E2  <  KT )  =  -C OS  <  A 7(  MT )  ) 

51  GOTO  20 

5?  15  El CMT)  =  -S  I  JC  ATC  MT)  ) 

53  E2CMT)=C0SCATCMT) ) 

54 

55 

pfi  C:  FORM  \JG  CA  AND  CN  FUNCTIONS 
57  ’20  ALP2=ALP*ALP. 

55  A  L  P3  =  ALP2  *  A  L  P 

5  ?  ALP4=ALP3  >=AI,  ' 

60  ALPS-AI-  i  ■  1  ^ 

61  -OMP-o. '1:^  ■. 

60  v3~  '  ■  , 

'.'i  'i 

fit  l 

65  C1=C  CP+Ci  J  *  A  L  P  *  C  C :  *  *  L  P  •'  +C  :  VALP3+U. Vd  +CC5*ALP5 
^6  CS*CC6+CC7*ML\J+CC8*MiMS+CC9*^W3+CC10^inki4+G;;i  1  *i  A<5 

67  CACMT)=Ci*CP 

68  MJ  =.v3C0+  \jC  P?  ALF  +  MCS*ALP2  +  NC3*ALP3+NC^*AL?4  +  .MC5*ALF5 

6  9  N2  *  NC 6+  NC 7*  MN+  NC 8 *M M2  +  ivC 9 *fc N3  +  ,\>C  1 0 *M >»4  +  vC  1  1  •:*  j5 

70  CM(frT)«\’l  *M2 

71  ♦  F  .\j*CNiC MT)  *QS 
7P  FA=CAC  MT) *0S 

7^  IF<F*/YC5)  *LE  •!  353  *0)  GO  i  0  g? 

7/1  IWDG^IMF^+l 

7  5  P3  CATC tfT>=COS CATC MT)  ) 

76  SA1  c  )  ::fO  AC  A  c  t  in  ) 

7  7  VOC  )-7Cr.O 
78  y  YC  1  •  •  >  <V  ) 

7  )>CC:  .)<<;.<  ■  :>  -FA.)  C.-.'l  Ci  1  )-FN*l  1  CM!  )  )/VC  5)  - 

80  F8CMT)*DYCS>) 

81  DYC3>=fC4) 

Rp  I  Y  C  4  )  =  C  C  TV C  /IT)  -FA) ATC  h  )-P  N*BP  C  t'-  T)  )/VC  5  ) 

83  FAC  KT) SDYC  4 ) 

84  DYC5)=-TTCMT)/8050*0 

85  IF  C  .VQ.gi )  GOTO  30 
*6  C:  SIMPLE'  INTEGRATION 

87  Y( 1 )»Y(  1  )  +  C  DY C 1 )+DYC2)*DT/P *0)*r T 

88  YCg)=rYC£)+DYCP)*DT 

89  YC  3 ) =YC  3)  +  C  DYC  3  )  +DYC  4 )  *l'T/g  -  c  )  *1  T  * 

90  YC  4)=YC  4) +DYC  4) *DT 
q\  yc 5 ) =YC 5 ) +DY C 5>*DT 

92  30  CONTINUE 

93 

94 

95  C:  SETTING  TARGET  COORD • 

96  Yn  =Y1  TO  +  D*  1  T*':F 

97  Y  3  r=  :.T!,C  +  »Y3'I*Th 
9  8 

Iff  C:  COST  EXPRESSION 

1  0*1  CT=TF  +UN*C  C  YC  1  )-Yl  )••  ••?>  .0  + (  YC  3  > -Y3T>**2  *0  ) 

102 

103 

104  C:  SET  Y  AND  DY  VALUF-S  FO-v  C  T  )  F  GuWPU  i  Mil  0  \) 

105  Y1K=YC  1  ) 

KV.  Y3F=  YC  3  ) 

107  DY1  F=J  YC  1  ) 

1  -Hi'  =  )  ,  C  :"•  ) 

1>»>'  -r  i  n  1'1  •'>  J '  ):■  J  :  •  -A!  s'  C  «-L 

110  32  WRITE  Cl  ..501)  ITG*  l  fib  f  i.  VL^P 


Ill  501  FORMAT!  4HITG=>  18.*  SHIlMDl  =  >  18*  5HINPG=>  18* //,  4HLTd=*  I P  *  »•  1C  OS  1  -,rl'  » 
1  1 

I  13 

114  Cl  FORMING  LAMBDA*  HT*  HAT*  CTTF 

II  -  Cl  DE-i  I  A/A  TI  Vi  OF  COST  •  H  •  T  •  FINAL  TIME 

il  :"  '•  ?=  1.0  +  P  .0  *UN*C C Y1F-Y1T)  *  (  TY1F-DY  1  T)  +  C Y3F-Y3T > *C DY3F- 
DY3T) ) 

1  1  7 
1  1  8 

119  C:  SETTING  FI JAL  VALUES  OF  LAMBDA 
IPO  LA  (])=,?. 0  *!.T\]!<  CY1F-Y1T) 

1P1  LAM( 2 ) =0  *0 

1PP  LAMC 3  )  =P .0*UN* C  Y3F-Y3  T  > 

1  r  3  1. A ■■'  (/l)  =0.0 
1  >  LAMC  5)  =0.0 
IPS 
IP* 

1P7  Cl  LOOF  FOF  GETTING  GRADIENT  AND  LAMBDA 
l^F  DT=TF/P0.0 

1  P-9  DO  BO  .Yf=Sl  *  1 

1.30  Ci  liO1  •  FOF  GETTING  DERIVATIVES  O.B. T*  STATE 

13  1  IF  CTATOT)  -GF  .  0.0  .AND.  TA'KMT)  .LE .  rI)  GOTO  3S 

IV?  JF  CTATCET)  .LE.  -PI  .OH.  TAT  <  •  T  >  •  EO  •  P-U+PI)  GOTO  35 

133  El AT=CATC  MT) 

134  F:PAT=SATC  ST) 

]  ns  ALT'  DA  t=-l  .0 

13  6  GO '10  40 

!  •>'/  3  5  4i_.-  !  41.!=  1  .3 

]  A-  ^l  /\  !  --CAT? MT) 

139  E8  4T=- S  4  T  C MT > 

140  40  ALPAT=  -ALPTA1J 

141  QS  YP=OSC*P  .0*Y8CiIT) 

142  QSY4=CSC*8  «0*Y4CMT ) 

1 43  VMS=C YPCMT>**8 .0+Y4CMT)**P .0) 

14  -'  V  =50'  TC  'v'>  S  ) 

145  0 c  =0 SC + V  S 

146  CTA(J=YPCMT) /VM 

147  STAU=Y4(MT)/VM 

14>  AL“YP  =  -"  LPT A  IK  C  I  A  INC  D>  T"=  i  4  C  )  /  C  /PC  •  i  )  *  r  L  C  i  .T  )  ) 

1  49  ALPY4=AL?TAU*CTAU**P/Y2Ct'T  ) 

1  Bn  Y  v’VP=CT«  VCS 
151  KNY  4=  5 T* L/C  3 
1  5P 
1  S  J 

1  ii  \j  •  FOF  "•  1  ••’(■  •  •• :  i/ )  T  / '/  ■*  t’D*  *  •  •  1  •  M 

It  “  ■  C  C  )  ) 

1  L  i  j  F  C  ( . :  .0  Y  •:  •  )  AT'  i 
1 57  ALP=AB 
1 53  GO  TO  44 
1 5^  43  ALP  =  9 • 0  * P I -AB 

160  44  A L P P  =  4 L  ' T A L 

161  ALP3=ALPPTALP 

1  60  AL. A  4=4 L? ■’  ALP 
'  '  ?!  F  S=AT .  4  4  6 

!  ;•  !.  M  1 

16  1  66 
j  •  '  .  i  ! 

167  M>J5=MN4*MN 

1 68  ClALP*CCl+8.0*CCP*ALP+3  .0*CC3*ALPy  +  ^  .  )*CC4*ALP3  +  5.0*CC5+ALP4 

169  CPMN=CC7  +  2  .0*CCE*KN+3  .0  +  CC9+MN8  +  4  .0*CC  1 0+MM3  +  5  .0*CC1  1  ;L ...4 

i  70  N1  AL.9=NC  1  +2  .0*NC2*ALP  +  3  .0*NC3*ALP2+4 .0*NC4*ALP3  +  5 .0*NC 5*ALP4 
1  71  NP  M  J=NC7+2.0*NCP*XN+3  .0*NC9*MN2+4  .0*NC  1  0*MN3  +  5  .O^NCl  1 
172  Cl  =CC0+CC1  *ALP+CCP*ALP2+CC3*AL  3  +  CC6'!:ALP4+CCb+Ai/  - 
17  3  C  2  =  C  C  6  +  C  C  7  *  M  N + C  C  P  *  M  N  ?  +  C  C  9  *  >';  N  3  +  C  0  l  Q  *  i\ . .  4  +  C  U 1  1  *  M  N  5 
1  74  Ml  =NC0  +  NC  1  *  ALP  +  NC  2  *  ALP2  +  ^3  *  ALP3  +  iNC  4  *ALP  4+ .'JC  b  *  ALI’  b 
175  N2=NC6+NC7*MN+NCf?*M.'J2  +  NC9*M.'J3  +  NC'l  O+M'W+.vCl  1  *MM5 
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17 6  CAAL?=C2*C1 AL? 

177  CAM  M=C  1  >:<CP'W 
17K  C.TALP=N2*>J1ALP 
179  CNMN=m*NPMM 

1  BO  FPYP=C  (  -CCAALP*CAT<MT)+C  MALP*r  1  (  Ml )  ) *ALPY2-< C AM  J*CAT  ( XT )  +CNKN*E  KMT) 
)  *MNY2  )  *QS  -  (  C  A  ( MT  )  *C  A  T  C  MT )  +C  N  C .-IT )  ■  -  K 1  Cut)  )  *G5  VP  )  /V  5  (  KT  ) 

1  P  1  F  ?V  4=( ( -(  CAM  =:  CAT  C  MT)+C^  I  P  i  T  1  (  T)  )  r ALPY4 -  ( C  AMN*CATC M  )  +CMM  \  (  Ml  ) 

)  *MNY4 )  *QS-  (  C A ( tMT )  *C  AT (  MT )  +C  N(  MT  )  *E  1  (  MT )  )  *GS Y4  )  /Y5  O  T  ) 

IBP  F2Y5=-F2(MT) /Y5(>  T) 

1  A3  F./jY8«(  C-CCAALP*SAT(MT)+CrJALP*E2CM)  ) *ALFYfc -(CAM  T*  2  AT C  MT) +C  NM  ■**££  (  1) 
) *KNY8 )  *QS  -  (  C  A  (  MT  )  *S AT (  MT  )  +C  MT )  *E?  (  Ml )  >*GSY2  ) /\ K  -.1 ) 

184  F  4  Y  4  =  (  (  -(  CAAL?*SATCMT)+CMALP*H:P.(  MT)  )  *ALP  Y4  -  (CAP  \J*SAT(  MT)+C  \l  •*  •;*££  (  •  V) 
>*MNY4  )  *05- (  CACMT)  *SAT(  MT)+C  N(  MT)  *E2  (  MT  ) )  *OSYa  )  /Y5C  MT  ) 


1  F  5 
186 

187 

188 
1  89 

190 

191 
1  98 
1Q3 

194 

195 
1  96 
197 
1  98 
\  99 
8  MO 


F  4Y5--F  '  Ci  1  )  /ysc  1  ) 


Cs  FOF.MIMG  d.e.  fo?  lambda 
DLAMC 1 )=0.0 

DLAMC  2 )  =LAM(  1  )  +LAMC  2  )  *F2Y2+LAiY  (  4  )  *F4Y2 
DLAMC 3 ) =0 .0 

DLAMC 4) -  LA K8) +FPY4+LAMC 3) +LAMC 4>*F4Y4 
DLAMC 5) =  LAMC 2)  *  FP  Y5  +  LAMA)  *  F 4 Y 5 


C:  UFVTLTU  I  NSTANTA  vkOUS  GRADIENT 
HT  C  MT )  =  LAMC 2)  *  F2T  +  LA1C4)  *  F41 
HATC  MT)  =  LAMC  2 )  *F2  AT  +  LAMC4) 

IF  CMT-EQ • 1  )  GO  TO  -60 


C :  DEP I  V A  T I VE 5  OF  i  r Y  W  .  r 
F2T=  1 .0/Y5C MT ) 

F  4T= 1  .0/Y5C MT) 

?  5T~-i *0/5050 *o 
P  28  ‘l’-  (  -  CCA'-.' 

) *0S /Y5C  MT ) 

20 1  F4AT=C-(CV\L* 

>*GS/Y5CM1 ) 

ROD 
80  A 
204 
PO  5 
P06 
P°7 
208 
P09 
pin 
pi  i 
pj  p 

213 
PI  4 

21  5 
PI  6 
PI  7 
PIP 
P  1  9 
ppn 
221 
222 
223 

22  4 
22  5 


T  •  TO  J.A 


c  T 

t  c  o+c  n  . 

*: .  i  j  ( 

)  ) 

;  J_ 

S3 

T  ( 1  IT  )  *C  iAU 

:•  SO  c 

0)5  ' 

l 

r-’J  Kiv  T  )  *P  1AT+CAC  <1  )  * 5  A  i  C  i*  i  ) 
i  -C  c  v  1  )  4  c  g  AT-;.  A  O  1  )  >.  c  ■  i  Ci  j  ) 


+  LAMC 5)  *  P 5T 
F4AT 


C:  SIMPLE  I MTFGRAT ION 
LAMC 2)  =  LAMC 2)  +  DLAMC 2) 
LA '•* C  4)  =  LA  Un 
LAMC  5)  =  LAMC  5) 

60  CONTINUE 


DLAMC 4) 
DLAP C  5  ) 


r>T 

ET 

DT 


Cs 

IK 


UP 
1  ) 


SETTING 
C  I  TG  •  M  4 
S3»0.0 
BFTA=0 .0 
*D=0 .0 

DO  65  Ml  =  1  >C<1 
5 1 C  MT ) =0 • 0 
S2  C  MT ) =0 -0 

65  GONTJ \JUE 


I  MI 1  I AL  IT 
CO  10  70 


NATION  AI.OW  SHM-Ch  DI H  •'01  I  C 


2  2  7 

828  CS  STAPLE  T  Ml' EG  2  AT  10  1  FO  ;  E  . 

P29  70  BM=0  *0 

230  DO  78  J*  1  >  80 

231  BM=  BM  +  (HATC  J  )*HATCJ  )+HTCJ  )*HT<J  ))+DT 

P32  72  CONTINUE 

233  B'M=  BN  +  CTTr  *  CTTF 

234  IFC  ITG  •  F  G  •  1  )  GO  10  74 
P 3 5  BETA ^BN/BD 


40 


236 'GOTO  76 

nv  7  4  DO  75  J=h«! 

29R  TTI  ( J)=TT( J) 

259  ATLf  <J)=AT<  J) 

9  40  KL!(J)=F;l(,)) 

2.'M  H.8(  ,l)a|  2!  ,]) 

2/2  'P.'OT.Y  (.)) 

i  !•  \  LP(  u)=Y2<  J) 

244  YL/'(J)=Y4(J> 

245  CAL(J)=CA(J) 

246  CNL(J)=CN(J> 

247  CATI.  ( J)=CAT(J) 

248  SATL( J)=SAT( J) 

249  YL5(J)=Yb(J) 

250  FLP<U)=F2(«.J) 

f-M  « .))  =F4< ,]) 

252  7  >  C'.Kl  1  MUE 
255  PYL1 F=T  Y 1 F 

254  DYL3F=DY3F 

255  jvru.=  iv;ni 

2.5  5  I.  g  >•  jl  -  I  O  H 

2'  /  TFL=TF 
255  C TL=C T 
‘  259  YL1F=Y1F 

260  YL3F=Y3F 

261  76  1 T= 1 

•2  6  7  7  IHIV.^.l)  GOTO  80 

267  5TK2=STHP0 
264  r,3»-CTTV  +  i  J  'lA  *S3 
Pf  ■  r  ri,=o 

266  S  IT.}  l.  =  0  .0 

267  DO  79  J=bHl 

26R  SI  ( <  J )  =-H T(  ,J)+::fh'TA*Sl  (  J) 

2  '  7  (  ,  )■>.}'.  A  '  "(6  ) 

2  71  >  tj  )\ ■  I  lvL  E 

271  GOTO  «5 

272  80  IF  ( IT.NE. ITMAX)  GO  TO  85 

273  V;;? I TE <  1  >600 )  IT*  I TMAX#  I TG*STE  PI*C'I i. 

274  600  FORMAT  (4HIT=  *  1 8  *  6H  I  TMAX  =  *  1 8*  4  - 1  TG=  *  1 6  *6HSTEPI.=  *  F  1  9  .8  *  4KCTL 
*F19 .2) 

275  GOTO  147 

276  8  5  INDT=0 

277  FS=0.0 

278  TFl -TFL+STKP*S3 

279  DO  95  J= 1  *  8 1 

220  TTI  (  J)=TTL(  .J)+STFP*s  i  c  J) 
pr i  ATI C  J)=ATL( J)+STEP*S2< J) 

282  IF! ATI !J)»GE«0»0 )G0T0  86 
2RR  ATI ! J)=AT1 ! J>+2.0*P1 

286  GOTO  87 

•88  6  !  -  IF! ATI  !  J)  .LF.2  .0*Pt  >G0  TO  87 
?l  6  ATI! U)=AT1 ! J>-8 .0*PI 

287  87  IE  (  TTH  J)  .LE.  1  4400  .0)G0TU  89 

288  TTI <  J)=l 4400  »0 
28  9  I  MDT=  I  MI  T  + 1 
2.,0  64  0  tO  91 

2  1  >•  fF< 'm  ( «J)  .G-,.n  .(OGO'VO  O 

48  T'i  KJJsp.C 
299  I MDT= I  Mr  T+ 1 

294  91  FS=FS+TT1 ( J)*DT 

295  95  CONTINUE: 

296  IF  (FS .LE. 38500 .0>G0  TO  9P 

297  DO  97  01=1 *81  41 

298  TTI ( J1  )=38500 .O/FS  +  T  II C  01  ) 

299  97  CONI  I  NUE 

.  300  WRITE! 1*700)  ITG*IT 


301  700  FOFMATt  6HT00  ti\J*  6rfCr,  M  6HL  U4  CD*  4H  X  T  G  =  >  1  &*  3P.IT  =  .»  J.  8 
3  OF 

SO  3 

70/1  i.;*  J  n  E GRATE  STEPPED  TRAJF  CT  OEY 

305  98  DO  105  J=D5 

306  Y1 C J)=YO( J)  . 

307  10  5  CONTINUE 

308  CS=1 1 17.77-90. 92*H 

300  0SC=0 .1734*  .00243*FXP(  -  .334/h ) 

310  DTI =TF 1 /RO  *0 

31 1  INDG=0 
3  1  P  I\JD1=0 

'*  1  3  DO  115  J=  It  8 1 

31 4  Y1PC J)=Y1 (2) 

315  Y14C  J)=Y1(4> 

316  VMS=Y1 <2)**2 .O+Yl <4)**2  .0 

317  V‘<1*SQ.RT<  VMS) 

31 R  QS=QSC*VMS 

319  MN=VM/CS 

320  TAU=ATAN2 <Y1(4)*Y1<P)) 

321  TATI  C  J)=TAU-AT3  ( «J) 

322  AB=A8f C  TAT)  <  J)  ) 

323.  IFCAP.GT.PI 5G0T0  117 

324  ALPHAS 

393  GOTO  120 

326  1  17  ALP*? • 0  *P I - AB 

397  190  DO  125  1=1 >5 

128  IF<  TAT  1  (  J)  .EO  .HC  ?.  )  )GOTO  1  80 

320  1  P  5  CONTI  'IDE 

330  130  i (  11*1=1  NDl  +  l 

331  I F C  TAT  1  (  J )  »GF  *0  *0  •  AMD  . TA T )  ( <J )  •  LF  •  °  1  )  GO  rD  1?- 

"39  IF  C  TATI  <  Jl.LE.-Pl)  GOTO  135 

333  El  1  <  J)=SIN<AT1  <«.")  ) 

334  F1PC  J)*-CCSCAT1  (  J)  ) 

335  GOTO  140 

336  135  El  1  <  J)»-SI  MC  ATK  J)  ) 

337  El?< J)=C0S<AT1 ( J) ) 

338  C:  F  OR  MI  MG  CA)  AMD  CM  F  j  N  IT  i  o  M  ' 

339  140  ALP?  =ALP*ALP 

340  ALP3=ALP9  * AL? 

341  A LP4=ALP3  *ALP 

342  ALP5=ALP4*ALF 

343  MN2=MN*MN 

344  MM3=^M2*KN 

345  M\4»MN3*MN 

346  MN5*MN4*MN 

347  Cl 1=CC0+CC1*4LP+CC2*ALP2+CC3*ALP3+CC4*ALP4+CC5*ALP5 

348  C1'2*CC6+CC7*:  v+CCG  '  •  f" >C'  .  N3+CC 1  0*.  K'+CC  1 1  *i-  iv-\ 

3/  -  CAJ  <o)*Cl  J  *C.U 

7  50  Ml  1  =NCO+NC  1  *ALP  +  NC2*ALF9+MC3*ALP3  +  MC4*ALP4  +  \C  5*AL.F  5 

351  N 19  =  EC 6  +  DC 7 +  IC  :  A  .  9 KC  1  3  +  F  ;  4+  C10  +  NC1 1  *MM5 

352  CN1 <  J) =N1 1  *M1  2 

353  FN=CN1 ( J)*QS 

354  FA=CA1<J>*0S 

335  IK(  F'N/Yl  ( 5)  •  ..  •  3  3  53.0)  C-OtO  1)3 

356  IMDG=INDG  +1 

357  1  1  3CAT1  (  ,}>=C0-<  VUf.i)) 

7  58  SAT  l  C  «J)  =  8 1  J(avi  Co)) 

359  Y1 5C  J)=Y1 C 5) 

?60  DY  HI)  =Y  1(9) 

3  :**  1  pv  1(P)=((7T1<  J)  -FA  )  +CAT1  C  M-F  M*E1  1  C  J)  )/Y  1  (  5  ) 

362  F1PC J)=DY1  (2) 

363  TY 1(3)=Y1(4) 

364  DY1 < 4)  =  C C TT1 C J)  -  FA)  *  SATl(J)  -  FN  *  El  2  C  J) )  /  Y1C5) 

365  F14C J)=DY1 C4> 


.366  DY1 C 5)=-TTl C J)  /  B050.0 
367  IFCJ  .EO.  81)  GOTO  115 
7*8 

369 

370  Ct  SIMPLE  INTEGRATION 

371  Y1 C 1 >=Y1 C 1 )+CDYl C 1  )+DYl  C  2  )  *DT  1  /?.  .0  )  *DT1 

37?  Y1CP)=Y1  C?)+DY1CP)*LT1 

373  Y1  C  3  )  =Y1  (  3  )  +  <  DY1  (  3>  +  DYl  (  4>*DT1  /'Pi.  .0)*LT1 

374  Y1 C 4)=Y1 C 4)+DYl C 4)*DT1 

*  375  Yl( 5) =  Y1 < 5>+DYl < 5)*DT1 

3 7 (  115  CONTINUE 
37  7 

,  378  C:  SETTING  TARGFT  COORDINATES 

879  Y1 T1 =YJ T0+DY1T*TF 1 
380  Y3T1  =Y3T0+1>Y3T*TF1 
39, )  C: 

38?  C: 

.7 • '  <  C :  COMPUTE  n  -  H’  COST 

‘'■■L'  r  1  =  '(•  i  +  I  )  :  f  (  1  c  1  ■>  -  i  1)  +  (  |(S)*i  •  )•**  .1  ' 

'T1  n  r  <J  ,rc  I  )  <  •'  (  ,  *  T  ,  I  v  n  ,  T  r  1  ,  F  s  ,  I  I 0  ,  C  T 1 

386  800  FORMAT  C  4H  I'TG  m*  %8r  31T IT**  16*  5H I N0T  =>  IKi  5H I  NI)  1  -»  16*  //  *  >  5  !•  S  ~  * 
F19.8*5HINrG=* I8*4HCT1=*F19.8> 

587  IFCCT1  «GE.  CTL)  GOTO  130 

388  DO  125  Jl  =  1  *  8 1 

389  TTLC J1 ) =TT 1 ( J1 ) 

390  ATLC J1 )=AT1 ( J1 ) 

391  ELI  C  Jl  )  =F,  1  1  C  Jl  ) 

39?.  i*  L2  C  J 1  )=E12CJ1  ) 

393  TATLC  Jl )=TAT1 <  Jl ) 

394  YL2C Jl ) =Y1 2  (  Jl  ) 

395  YL4 ( Jl >=Y1 4( Jl ) 

*  396  CALC  Jl ) =CA1 C  Jl ) 

397  CNLC  Jl  >=CN1  C  Jl  ) 

398  CATLC Jl )-CATl ( Jl ) 

»  399  SATLCJ1  )=SAT1  C  Jl  ) 

400  Y1  5<  Jl  )  =  Y1  5C  Jl  ) 

401  FL7< Jl >=* l°< Jl ) 

40?  K8.4C  Jl  )=F5  4C  Jl  ) 

/'O’  IP*  CONTI NUF 
404  INTI  - I NPl 

4 0  5  I  :aT<-L=I  WDC 
40*  TKL-’lFl 
40/  CT J-CT 1 

408  STF°I  “STEP 

409  YLIF=Y1 ( 1 ) 

410  YL3F  =Y 1 C  3 ) 

411  DYL1F=DY1C1) 

41?  FYL3F=DY1 C  3 ) 

413  I TL= I T 

414  GOTO  140 

41,5  17:3  5TFP=STEP/P  .0 

416  I F  ( STEP  .LT.  STEPi'i )  GOTO  145 

417  140  I T= I T+ 1 
413  GOTO  77 

419  145  WR I  TEC  1  *  900 )STEP*  STEPM* ITL*CTL*I STEPL 

420  900  FORMATC  5HSTEP  =  *  FI  9  »8*  6HSTEPM  =  .»  FI  9  »8>  AH  I  TL=*  I8>  //>  4HC  TL  =  #  F 1  9  •  8^ 
4HITG  =  .»  I8^5HSTEPL  =  ^F19  .8) 

421  147  IFCCTL.EQ .CT)  GOTO  2000 

*  ,422  DO  150  Jl  =  1  ^  8 1 

423  TTC Jl )=TTLC Jl ) 

4?4  ATC Jl )=ATLC Jl ) 

425  YP.C  Jl  )=YL2C  Jl  ) 

426  Y4C Jl )=YL4C Jl ) 

427  El  C  Jl  )  =EL1  C  Jl  )  43 

4?3  ESC  Jl  )=EL.PC  Jl  ) 

42 9  TATC Jl )=TATLC Jl ) 


430  CAC J1)=CAL( Jl ) 

431  CNCJ1)=CNLCJ1) 

432  CATC Jl )=CATLC Jl ) 

433  SATC J1 )=SATLC J1 ) 

434  Y5<  Jl  )=YL5<  J1  ) 

435  F 2 C  J 1 >=FL2C Jl) 

436  r4CJl)=FL4C Jl ) 

437  150  CONTINUE 
43R  TF  =  TFL 

439  SD=BN 

440  CT=CTL 

441  INDl=tfNDlL 

442  I NDG=INDGL 

443  Y1 F =YL 1 F 

444  Y3F-YL3F 

445  DY 1 F =DYL 1 F 

446  DY3F=DYL3F 

447  IFC ITG.GT.ITKAX)GOTO  2100 

448  I TG=I TG+ 1 

449  Y 1 T=Y 1 T0+DY1 T*TFL 
450'  Y3T=Y3T0+DY3T*TFL 

451  GOTO  3? 

452  2000  WRITEC 1 >902) ITG 

453  902  F0RM4TC  6H.N0  IMP>6HR0VEME>6HNT  F0S>6HSIBLE  >6HFF.0/i  G> 

6HRADI EN> 6HT  IN  T>6HHIS  DI  > 6HRECTI0> 6BN>  >6HITG=  >18) 

454  C:  (NO  IMPROVEMENT  POSSIBLE  FROM  GRADIENT  IN  THIS  DIRECTION) 

455  GOTO  5000 

456  2100  WR I  TEC  1 >903) 

457  903  FORMATC  6HITG=IT>  6HGMAX  ) 

458  5000  STOP 

459  END 


i 
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